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INTRODUCTION 


The  six-degree-of-frecdom  (6-DOF)  equations  of  motion  are  derived  in  vector  form 
for  a  hinged  vehicle  flying  over  a  spherical  Earth.  Initially,  the  most  general  form  of  the 
equations  is  developed  assuming  the  combustor  may  roll  with  respect  to  the  body,  as  well 
as  deflect  in  pitch  and  yaw.  Next,  the  primary  case  is  developed  in  which  the  combustor 
catmot  roll  with  respect  to  the  body.  Finally,  these  equations  are  specialized  to  three 
simpler  cases.  The  motivation  for  deriving  this  set  of  equations  is  to  support  feasibility 
studies  of  the  low  drag  ramjet  (LDR),  which  is  streamlined  by  deleting  all  aerodynamic 
surfaces.  All  directional  control  comes  from  thrust  vectoring,  which  is  accomplished  by 
deflecting  the  entire  motor  rather  than  just  the  exhaust  nozzle,  as  in  more  conventional 
designs.  Since  the  motor  is  a  large  fraction  of  the  total  vehicle  mass,  its  inertia  has  a 
significant  effect  (xr  the  dynamics  of  the  overall  vehicle. 


GENERAL  SIX-DEGREE-OF-FREEDOM  MOTION  OVER  SPHERICAL 
EARTH  WITH  ROLLING  HINGE 


To  fully  describe  the  trajectories  of  two  rigid  bodies,  24  first-oider  scalar  differential 
equations  are  needed.  For  each  body  there  are  12  equations,  three  for  each  of  the 
following;  position,  attitude,  velocity,  and  angular  rate.  In  this  case,  however,  the  task 
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of  developing  the  angular  and  translational  acceleration  equations  is  simplified  by  the  fact 
that  the  combustor  is  attached  to  the  body.  The  hinge  makes  the  velocity  and  acceleration 
of  the  combustor's  center  of  gravity  (CG)  a  function  of  the  combustor's  attitude,  angular 
velocity,  and  the  body  states.  In  this  section,  the  combustor  is  allowed  to  roll,  pitch,  and 
yaw  with  respect  to  the  body. 


An  additional  simplification  results  from  the  assumption  that  the  mass  properties  of 
each  body  change  slowly,  mg-Q,  rhc-O,  fg^~0  and 

»  0.  The  missile  geometry  is  illustrated  in  Figure  1,  and  the  notation  is  explained  in 


detail  in  the  notation  secticm  at  the  end  of  this  rq>ort. 


NEWTON'S  SECOND  LAW  APPLIED  TO  WHOLE  VEHICLE 


Apply  Newton's  second  law  to  the  whole  vehicle,  where  the  forces  and  moments  in 
the  hinge  are  as  illustrated  in  Figure  2.  (Reference  1  has  a  good  statement  of  Newton's 
second  law.)  External  forces  and  moments  are  assumed  to  act  at  the  combustor  and  body 
CGs. 


^myVy)  _  +myG 

at 


(1) 


In  Equation  1,  the  subscript  "V"  refers  to  a  quantity  that  applies  to  the  overall  vehicle.  A 
subscript  "C"  refers  to  the  combustor  or  motor  section,  and  the  "B"  subscript  refers  »o  the 
main  body. 
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FIGURE  1.  Vehicle  Over  Spherical  Earth. 
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-Fh. 


Fh, 

COMBUSTOR 

FIGURE  2.  Forces  and  Moments  in  the  Hinge. 

Since  the  location  of  the  vehicle  CG  relative  to  both  bodies  varies  with  combustor 
deflection  angle,  and  the  inertial  measurement  unit  will  be  located  in  the  main  body,  the 
body  CG  is  the  reference  point  for  these  equations.  The  body  acceleration  is  derived 
from  the  vehicle  acceleraticm  as  follows: 

fltyOy  —  nigOg  +  niQOQ 

myQy  =  mgag  +  mcag  +  mcOc  -  nicag 
My  Gy  =  (mg  +  mc)aj  +  mc(ac  -  Og) 
ntyGy  =  ntyag  -^mQOQig 
ntyOg  —  ntyOy  — 

The  "ocig"  is  the  acceleration  of  the  combustor  with  respect  to  the  body.  This  is  a 
noninertial  acceleration.  Since  the  combustor  is  attached  to  the  main  body,  its  position 
relative  to  the  main  body  can  be  described  algebraically. 

Xc  =Xb+Xcib 
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+  ^hlB  +  ^C/A 

%  -^b'^Pb 

Differentiate  for  combustor  velocity: 

<£cr  _ 

Vc=-^  =  Vb  +  vc/b 

Vc  =  (^B  +  0)b  ^  ^b]  (^C  +  ^  ^c] 

Remember,  Pg^^O  and  “  0 
Vc  ®B  ^  /^fl  ■*■  ®C  ^  Pc 
Differentiate  a  second  time  for  combustor  acceleration: 

— 

flC  =“^  =  flB+dC/B 

oi:  =  Ofl  +[^5 xPg+mg  X  +  6)2,  x{©5 X^a)] 

+[®C  x^c  +2)c  xfc  +%  x(St  x^c)] 

Since  Pg  and  Pc  are  assumed  to  be  near  zero, 

ac-ag+^gXpg  +  agx(agX  Pg]  +  &c  X  ^  +Sc  x(©c  X  Pc) 

Isolating  the  acceleration  of  the  combustor  with  respect  to  the  body, 

ac,B  =aBXPg-^WgX  (ofg  xPg)  +  Bcx^+^c^  (®c  X  Pc)  (3) 

Inserting  Equations  1  and  3  into  Equation  2  yields  an  expression  for  the  inertial 
acceleration  of  the  main  body  CG 

ntyOB  —  Fg  Fc  myG 

-mc]^B  X  ^B  +  X  (6)2,  X  ^b)  +  X  Sic  X  (wc  X  ^c)]  (4) 
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Because  the  body  and  combustor  angular  rates  are  relative  to  inertial  space,  they 
include  the  rates  attributable  to  the  spherical,  rotating  Earth. 

0>C  -  ^C/B  +  ^B/H 
0>B  =  ^B/H  +  ®W/G  +  ®G 

The  inertial  acceleration  of  the  body  CG  is  now  known.  But  it  is  more  useful  to 
know  the  body  acceleration  relative  to  the  body  frame,  ^b/gI^  (s®c  the  notation  section), 

since  this  is  what  a  strapdown  accelerometer  located  at  the  body  CG  would  measure. 
Expanding  the  body  CG  acceleradon  in  terms  of  body  angular  velocity  yields 

5b  =  +  2©G  X  +  ^G  X  +  5)c  X  (©G  X  Xb  ) 

5b  =  ^b/g|g  +  25>g  X  VBfc  +  Sg  X  (®c  x  xb) 

where 

^B/c|<3  =  ^BIg\b  +  ®B/G  X  Vb/G 
and  Wq  is  assumed  to  be  zero. 

5b  =  ^b/gIb  +  {^BIH  +^H/c)^ ^Btc  +  2©g  X vb/g  +  X (©g  X Xb) 

Rearrange  to  isolate  the  different  types  of  acceleration. 
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+25>c  .'  .g/G 
+©gx(6)gX^b) 


Coriolis 

Centrifugal  relief 


Flat  Earth 
Spherical  Earth 

Rotating  Earth 


\iserting  this  into  Equation  4  and  placing  all  derivatives  on  the  left  side  yields  the 
Erst  of  the  three  vector  differential  equations  for  translational  and  angtilar  velocities. 

"*vVB/cfg  +'”c(®c  ^Pb) 

=  Fg  +  7^  X ni\rG  —  Wc[h)c  x (o^  x  ^ j  +  (t>g  x  ^(Og  x  fig^  (5) 

—my^tOgiG  X  Vfl/G  +  2tUG  ^  ’•’B/G  '•‘^G  ^  (^G  ^  ^b)] 

CONSERVATION  OF  ANGULAR  MOMENTUM  FOR  MAIN  BODY 

Conservation  of  angular  momentum  for  the  main  body  about  its  own  CG  is  the 
starting  point  for  the  next  derivation. 

-^{h<^B)  =  Mb  +  Mh+Pb^^h 

At  this  point,  an  assumption  is  made  about  the  forces  internal  to  the  hinge.  The  servo  is 
assumed  to  exert  a  pure  couple  (see  Figure  2).  Thus,  the  force  internal  to  the  hinge 
between  the  body  and  the  combustor  is  deEned  by  Newton's  third  law.  (Reference  1  has 
a  good  statement  of  Newton's  third  law.)  TTiis  force  is  not  generally  measured,  so  it  is 
eliminated  by  applying  Newton's  second  law  to  the  combustor,  solving  for  the  force  in 
the  hinge  and  substimting  for  it  in  the  angular  momentum  equation  for  the  body. 

TTIgOc  ~ 


8 


NAWCWPNS  TP  8134 


Substitute  for  Ff^, 

— =  +M;,  x(Fc  +/ncG  ~fnc^) 

Expau  ■  out  the  derivative  on  the  left  side. 


0}g+fBd)B  +  (0B  x/fltUB  - 


Remember,  I  b 


=  0 ,  expand  out  and  place  ail  derivatives  on  the  left  hand  side; 


+■  Pb  '^^{^BIg\b'^^C  ^Pc^^b  ^Pb) 

=  Mb  +  M^  +  Pbx{Fc  +  mcG'j-S)B  x 

-Pb  X  X  Vb/g  +  2C0g  X  Vb,g  +  Wg  X  {cog  X  Xb)] 

~Pb  X  AWc[®C  i^c  xPc)  +  ^B^(^B^  Pb)] 


(6) 


CONSERVATION  OF  ANGULAR  MOMENTUM  FOR  COMBUSTOR 

The  development  of  the  angular  momentum  equation  of  the  combustor  about  its  own 
CG  is  very  similar  to  that  for  the  body.  At  this  point,  the  combustor  is  assumed  to  be 
able  to  pitch,  yaw,  and  roll  with  respect  to  the  body. 

^(/c®c)=  ®C  -?C  x(-P») 

=  Mq  —  Mf,  +Pc'^  (f^c  +  —mcOc) 
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Expand  out,  assuming  /cj^  «  0  and  leairange. 

Ic^c  +  ^  +  5>c  X  j3c  +  X  j 

=  —  Mf,  +  (^c  ■*■  )  ~  ®c  ^ 

~^c  ^  201(3  ^  Vb/(3  +  0)(3  X  (o>(3  X Xg)] 

-A:  xwic[fflc  x(o)c  X  A:)+0)b  x(o)g  x^g)] 


Because  the  two  bodies  are  connected,  Equations  5, 6,  and  7  are  coupled  and  must  be 
solved  simultaneously.  This  can  be  done  by  rearranging  so  that  the  whole  set  of 
equations  can  be  treated  as  a  single  nine-element  vector  differential  equation,  which  is 
then  inverted  to  solve  for  the  state  derivatives.  To  do  this,  a  common  coordinate  system 
must  be  chosen  for  all  three  equations.  The  simplest  choice  is  the  body  frame.  Second, 
all  vector  cross  products  to  the  left  of  the  equal  sign  must  be  replaced  by  matrix  products. 
In  general,  a  vector  cross  product  can  be  replaced  by  a  matrix  product  as  follows: 

ay.b  =ab 


where 

a 


-Oz 


0 


-Ox 

0 


Also  in  general. 


axb  =  -b  xa 


These  two  rules  must  be  applied  to  the  left  side  of  the  equal  sign,  but  for  aesthetics,  they 
are  also  applied  to  the  right  side.  The  result  after  rearranging  is 
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myl  —mcPi  ~^Pc 

f-B  1 
vb/gI^ 

mcfic  {^c  ~^M^) 

©c 

Fjg  +  F(^  +  ntyG  ^ 

0 

0 

MS+M(Fc+mcG^) 

^B^B^B 

Me  +M{Fc 

-mS_ 

cbcic^c. 

mc{(S)c^cPc  )+^{®bVb/g  +2d)cv//c  +d>ccl>GXB^ 

^B/G^BfG  ^G^B/G  ^g^g^b)  ’ 

ffk:M{^c^cPc  +®fl®B^B  +^b/gVb/g +2©cVb/g +  ^g®g^b) 


(8) 


The  matrix  premultiplying  the  derivative  vector  serves  as  an  expanded  inertia  tensor. 
Written  in  partitioned  form  above,  it  appears  to  be  nearly  skew  symmetric.  However, 
when  (tediously)  expanded,  it  is  symmetric. 

To  make  use  of  this  equation,  each  vectm*  in  Equation  8  must  be  written  explicitly  in 
the  body  frame.  Selected  vectors  are  listed  below.  Figures  1  and  2  and  the  nomenclature 
section  provide  further  information. 

Body  CG  location  with  respect  to  the  hinge  and  hinge  location  with  respect  to  the 
combustor  CG: 


II 

-(/b~^b) 

0 

’  «  ^C-[2c2b} 

0 

0 

0 

Gravitational  acceleration: 
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Body  position:  The  position  of  the  body  CX3,  Xg,  is  relative  to  the  inertial  reference  point 
at  the  Earth's  center.  Thus,  the  z-component  of  (body  CG  position  expressed  in 
the  local  horizontal  frame)  is  (y?£  +  A). 


Angular  velocity  of  the  ground  frame: 


-  [^GIb} 

0 

■  -  [^H2b]['^G2h} 

0 

0 

0 

Angular  velocity  of  local  horizontal  frame  with  respect  to  the  ground  frame: 


[0] 

x 

^H/G=[Th2b] 

* 

0 

► 

[oj 

0 

Combustor  inertia  tensor  7®  =  [Tb2c]^c 


KINEMATICS 

In  the  preceding  section,  nine  of  the  18  differential  equations  describing  the  motion  of 
the  two  connected  bodies  were  developed.  Additional  differential  equations  that  describe 
the  position  and  attitude  of  the  vehicle  are  now  needed.  Stan  with  the  attitude  of  the  main 
body  with  respect  to  local  horizontal.  Remember,  on  the  spherical  Earth  the  local 
horizontal  frame  rotates  with  respect  to  the  inertial  frame.  The  body  frame  is  related  to 
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local  horizontal  by  the  Euler  rotation  sequence  iff  about  z,  6  about  y,  and  0  about  x. 
The  inertial  angular  velocity  of  the  body  is 

~  ^BIH  ^HIG 

-  (Ohig  ~ 


Again,  use  the  body  frame. 


_ 

®B///  - 


"1 

0 

0 

1 

0 

0 

COS0 

0 

-sin© 

-0 

>+ 

0 

COS0 

sin0 

•  + 

0 

COS0 

sin0 

0 

1 

0 

0 

0 

-sin0 

COS0 

loj 

_0 

-sin0 

COS0 

sin© 

0 

cos© 

yj 

'1 

0 

-sin© 

0 

0 

COS0 

sin0cos© 

© 

0 

-sin0 

COS0COS© 

y. 

Solve  for  the  Euler  angle  rates  using  Cramer’s  rule: 


’  < ' 

0 

1 

tan©sin0 

tan©cos0 

© 

.  =z 

0 

COS0 

-sin0 

Ir 

0 

sin0 

COS0 

COS© 

cos©  . 

^B/H 


(9) 


An  important  drawback  exists  to  using  the  differential  equations  for  Euler  rotation 
sequence  to  describe  the  body  angular  motion.  There  is  a  singularity  in  the 
transformation  matrix  at  fl  =  90  deg,  i.e.,  when  the  body  is  vertical.  An  alternate  way  to 
relate  the  inertial  and  the  horizontal  frames  is  by  using  quaternions.  This  method  yields  a 
transformation  matrix  that  has  no  singularities  and  that  can  be  calculated  more  rapidly  by 
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computer.  However,  quaternions  are  not  physically  intuitive,  and  this  vehicle  should 
never  reach  a  large  pitch  angle,  so  Euler  angles  were  used  in  this  development. 

Next,  determine  the  position  on  the  surface  of  the  spherical  Earth  of  the  body  CG 
with  respect  to  a  reference  point,  usually  the  intersection  of  the  prime  meridian  and  the 
equator. 

^BIG=^HIG+^BIH 
XbIG-^^H  ~^g)'*‘^BIH 

Note  that  the  origins  of  the  body  and  local  horizontal  frames  coincide,  so  Xgjif  =  0. 
Differentiate  with  respect  to  the  ground  frame: 

^B/G  =  ^big\q 
%IG-^h\(;~^g\c 

Assume  the  Earth  rotates  at  a  constant  rate  about  the  axis  through  the  poles,  ^  • 

Vfl/G  =  ^H\if  +  ^HIG 


To  solve  for  the  latitude  and  longitude  rates,  this  equation  must  be  expressed  in  scalar 
form.  Choose  the  local  horizontal  frame: 

Vfi/G  “  I//  ^ 

^B/G  =[‘^B2w]vi/G 

— f/ 

Note  that  for  a  spherical  earth,  VgfQ  is  a  non-inertial  quantity.  In  a  later  section,  when 
the  equations  are  reduced  to  flat  Earth,  it  will  be  inertial.  To  avoid  confusion  with  the 
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inertial  velocity,  we  will  add  the  superscript  "H"  to  each  clement  of  the  vector,  keeping  in 
mind  that  the  two  become  identical  for  flat  Earth. 


- 

vb/c  - 


M 


w 


H 


u" 

V« 

. 

01 

’  •  ' 

A  cos  4 

0 

■  0 

>  +  ■ 

X- 

0 

-h 

-Xsin^ 

-(Rs  +  h) 

Solving  for  the  spherical  coordinate  rates: 

RE  +  h 

X  =  —J. _ 

(R£  +  h)cos4 

h  =  -w^ 

The  geographic  position  is 

X  =  Re^ 

Y  =  ReX 

The  final  equations  needed  are  for  the  combustor  deflection  relative  to  the  body. 
0>CfB  —  ~ 

Write  out  in  the  body  frame. 


(10) 

(11) 

(12) 


15 


NAWCWPNS  TP  8134 


cos5^  cos^j  —  sin 

P 

cosSy  sinS^  +  Sy  cosSj 

>  =  Q)S-^B=' 

R 

-S^  sin  Sy+Sf 

r 

(13) 


By  convention,  p,  q,  and  r  are  assumed  to  be  angular  rates  about  the  axes  of  the  body 
frame.  (Og  and  (Oq  are  available  from  integrating  Equations  8.  Solving  for  the 
combustor  deflections  yields 


1 

tan  ^2 
0 


-cos5y  tan^^ 

CO&Sy 

0 


sinSy 

sin5y  tan^j 
1 


(14) 


Remember,  the  combustor  deflection  angles  are  modeled  as  an  Euler  sequence  in  this 
development.  This  choice  was  made  for  convenience  in  the  formulation  and  would 
represent  a  set  of  nested  gimbals.  Depending  on  how  the  actual  servo  is  designed,  some 
other  model  might  be  more  appropriate. 

The  combustor  CG  velocity  is  available  algebraically.  Though  it  is  not  needed  for 
simulation  of  the  vehicle's  motion,  it  is  provided  here  for  reference.  Remember,  the 
subscript "  h "  refers  to  the  hinge. 


^CJG  -  ^C/B  +  Vfl/C 

=  0)ciG^Pc'^  ^BIG  ^  +  I'fi/C 


For  interest,  the  surface  distance  flown  along  a  great  circle  since  launch  is  also  included 
(Reference  2): 
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/?  =  /?£COs"^|cos(^|— 52]cos^f -^i]cos(A2 

The  motion  of  the  missile  and  combustor  have  been  fully  described.  Equations  8 
through  12  and  Equation  14  describe  the  dynamics  of  the  vehicle's  18  independent  states, 
subject  to  the  following  assumptions: 

1.  Combustor  and  body  are  rigid 

2.  Control  servo  in  the  hinge  only  exerts  pure  couple 

3.  Hinge  can  be  modeled  as  a  gimbal  set 

4.  Earth  is  perfectly  spherical,  rotating  at  a  constant  rate 

5 .  Mass  properties  of  the  two  vehicle  secticms  change  "slowly" 


GENERAL  SIX-DEGREE-OF-FREEDOM  MOTION  OVER  SPHERICAL 
EARTH  WITH  NO>ROLL  HINGE 


Adding  the  constraint  that  the  combustor  may  not  roll  with  respect  to  the  body 
removes  a  degree  of  freedom;  the  combustor  roll  rate,  a>^  ~  Pc  •  longer 

independent  and  is  deleted  from  the  state  vector.  Further,  is  just  a  reaction  moment 
and  is  eliminated  from  the  equations.  Dcnng  this  will  reduce  die  size  of  the  state  vector  to 
be  integrated,  but  will  also  destroy  the  nice,  compact  form  of  Equation  8. 

Define  Pc  using  Equation  13,  remembering  that  5,  =  =  0. 
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'  . 

-5j,sin5j 

f 

P 

SyCOSSj 

R 

r 

The  y  ami  z  elements  yield  differential  equations  for  Sy  and  S^. 

A  ~S£JA. 

^  cosBj 
K  ~  'CIB- 

Use  the  x  element  to  relate  Pc  to  the  other  states. 


(15) 

(16) 


Pc  IB  -  Pc  ~PB=  ~^y 

Pc  =  PB-SySinSj 

Pc  =  PB-(‘7c-<7B)tan5,  (17) 


Differentiate  and  use  the  expression  for  6j. 
Pc  =  Pb-  {Qc  -  qi»)tan5,  - 


(18) 


Set  up  the  following  definitions  to  make  subsequent  work  nx>re  compact 


K 

0 

/nc(©c®c/^c  ^B^bPb)'^  ^{^B^BIG  ^^G^BIG  ^G^G^B  ) 

h 

»  =  — 

(®C®C^C  ^B^B^B  ^BIG^BIG  ^^G^BIG  ) 

J^c. 

!^ric^c. 

f^M{^C^cfic  ^B^bPb  ■*■  ^B/G^BIG  ^g’^BIG  ®G®G^B  ) 

(19a) 
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7v' 

Fjg 

<■  =  < 

Ml  +  fiS(Fc^  +  mcG^)- 

fc. 

Wc+3c(¥+"«cG^) 

Jll 

712 

713' 

myl 

-ffk:PB 

( - 

J21 

722 

723 

= 

{Jb 

731 

732 

733 

{jc 

Equation  8  then  becomes 


'711  712  713 
721  722  723 

vI/gI^ 

»  =  • 

'/v 

>+> 

0 

•+• 

r  “  \ 

K 

kb 

731  732  733 

A. 

-mS 

A. 

Remember, 


(19b) 


(19c) 


(20) 


'^bigL  I  Pb  <Ib  'b  !  Pc  Qc 


.  m/ [={o  0  oIm£  MjJ  -mS,  -MS,f 

-»l\ 


B 

Solve  the  seventh  equation  in  Equation  20  for 

+y31i2v|/c|g  +*f31i3w|/<5j^j+[/322iP5  +  /32i2qB  +  /32i3rB] 

+[733nPc  +  J^^n^c  +  "^3313  rc]  =  fcx~^L'^^x 
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Afta  +"^31i2v|/c|g  +-/31i3w|/G|^j~[‘^32iiP5  +  y32i29s  +  /32i3r5] 

-[/33iiPc  +  ■^33i2flc  +  *^33i3rc]+/cx  +  kcx 

Substitute  into  the  fourth  differential  equation  in  Equation  20 

|^721iijif/G|^  +  /21i2v|/g|j  +  •^21i3w|/c|^]+[-^22iiPb  +  J22i2Qb  +  -^2213;^^] 

+[723iiPc  +  •^23i2^c  +  •^23i3rc]  =  fBx  + 

^721nii|/c|^  +  721i2v|/c|^  +  721i3w|/Gj^j+[/22ii/>5  +  722i2^b  +  >^2213^^5] 

+[y23iiPc  +  •^23i24c  +  •^23i3/t] 

=  -|731nii|/G|g  +  •/31i2v|/G|g  +  •^31i3H'|/g|^| 

— [732jiPa  +  /32i24b  +  '^32i3rg]— [/33nPc  +*^33i2^c  '•'•^3313/^] 

+/bx  +  fcx  +  *ar  +  ^ 


Place  all  the  derivatives  on  the  left  side  and  write  out  the  full  matrix  equation.  The 
result  is  shown  in  Equation  22  at  the  end  of  this  section.  To  eliminate  the  extra  state  pc , 

insert  Equation  18  into  Equation  22  and  rearrange.  The  result  is  shown  in  Equation  23  at 
the  end  of  this  section. 

Now,  for  the  specific  vehicle  being  modeled,  this  equation  can  be  simplified.  First, 
the  deflection  angles  ate  fairly  small,  and  s^xtnd,  the  deflection  rates  are  large  in  only  one 
direction  at  a  time,  i.e.,  Sy  and  5^  will  not  be  large  at  the  same  time.  Referring  to 

Equation  18, 

Pc  =  Pb-{Pc 

cos  dj 
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Recall  that  6y  -  [q^  -  ^^)/cos5^  and  6^  -  (r^  -  Tg). 

Pc^Pb-  (qc  -  qsjsind^  - 

cosd^ 

Apply  small  angle  assumption: 

Pc  "Pb~  {Qc  ~  4b)^2  - 

Ronember  that  dy  and  6^  will  not  be  large  at  die  same  time: 

Pc"Pb  (21) 

^jplying  this  yields  Equation  24. 

Equation  22 


0 

0 

0 

0 

0 

0 

• 

711 

1 

712 

1 

713 

0 

0 

0 

1 

1 

1 

73111 

73112 

731i3 

r  *■ 

721 

1  ■ 

1 

1 

722 

- 1 - 

1 

1 

723 

+ 

7. 

73121 

73I22 

73123]  73221 

73222 

73223]  73321 

73322 

73323 

0 

0 

0 

73131 

73I32 

73I33  i  73231 

73232 

73233 !  73331 

73332 

73333 

0 

0 

0 

0 

0 

0 

0 

0 

0 
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Equation  23 


• 

713i2 

713i3l 

0 

0 

0 

713ii 

ill 

712 

71322 

71323 

0 

0 

0 

71321 

^1332 

71333 

0 

0 

0 

L. 

71331 

72^2 

723i3 

73111 

73112 

731i3 

r  732ii 

J21 

722 

72322 

72323 

+ 

+(j23i,+J33i,) 

0 

0 

0 

72321 

72332 

72333 

J3121 

/3122 

/3123 

73221 

73222 

73223 

73322 

/3323 

0 

0 

0 

72331 

/3131 

/3132 

73133 

73231 

73232 

73233 

73332 

-^3333 

0 

0 

- “1 

0 

73321 

0 

0 

0 

73331 

^13ii 

0 

71321 

fv 

fc  X  ^  X 

icy 

71331 

fa 

f  +  1 

Mhy 

1 

X 

1 

+ 

fcy 

mL 

cos^ 

72321 

fcz 

-Mgy 

*Cr 

72331 

-Mhx 

73321 

73331 

23 


J13ii 

713iitan52 

0 

-713iitan62 

0 

J1321 

71321  tan 

0 

-71321  tanfi2 

0 

Jlhi 

71331  tanfi^ 

0 

-71331  tand2 

0 

] 

J32^ 

732i3 

733i2 

/33i3 

(/23u+y33i,) 

+(723ii  +733ii)tantfj 

-(723ii+733ii)tan<52 

J2321 

72321  tan  ^2 

0 

-72321  tan62 

0 

J2331 

72331  tan  ^2 

0 

-72331  tan  ^2 

0 

73321 

73321  tan  62 

- - 

0 

ton  6^ 

0 

73331 

73331  tan  ^2 

0 

-73331  tan  ^2 

0 
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Equation  24 


1 

J12 

713i2  713i3- 

71322  71323 

71332  71333 

0  0  0 

0  *0  0 

000 

713ii 

713,1 

71331 

723,,  723,, 

731„  731„  731,, 

732,1 +723,1 +733,1 

J21 

722 

723,2  723,3 

+ 

0  0  0 

723,1 

723,2  -^2333 

^3121  J3\f^ 

73221  73222  73223 

«/33^  «/33^^ 

0 

0 

0 

72331 

ySl^j  ^31j2  *^^133 

73231  -^3232  73233 

J3^22  *^^^33 

0  0  0 

733,1 

0  0  0 

73331 
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/13ii 

0 

0 

0 

0 

J1321 

0 

0 

0 

0 

71331 

0 

0 

0 

0 

1  +723ii  +733ii 

732i2 

732i3 

733i2 

733i3 

72321 

0 

0 

0 

0 

72331 

0 

0 

0 

0 

73321 

0 

0 

0 

0 

73331 

0 

0 

0 

0 
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SPECIAL  CASE:  SINGLE  RIGID  BODY 

When  the  second  body  is  removed.  Equations  8  decouple  and  can  be  treated  as  three 
separate  vector  equations,  rather  than  as  one  9-element  equation.  Further,  the  differential 
equations  for  ,  Sj^,  Sy,  and  are  typically  replaced  by  three  second-order  equations 

to  adequate  fidelity.  This  is  the  case  for  most  missiles,  both  thrust  vector  controlled  and 
aerodynamically  controlled,  because  the  mass  of  tiie  deflecting  noz2de  or  control  surface 
is  negligible  relative  to  the  total  mass  of  the  rest  of  the  vehicle,  and  the  distance  from  the 
hinge  to  the  CG  is  small.  The  effect  of  the  second  body  on  the  dynamics  is  restricted  to 
its  contribution  to  the  forces  and  moments  on  the  body.  From  Equation  8,  the  equations 
for  the  body  velocity  and  angular  rate  are 

~  ^  +  2©gv|/G  +  ) 

U&l  =  Mg+  figpi  +  mS  -  © 

The  remaining  Equations  9  though  12  are  unchanged. 
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SPECIAL  CASE:  FLAT  EARTH 


For  flat  Earth,  the  radius  of  the  Earth  becomes  infinite  and  its  angular  rate  zero.  The 
gravitational  Held  is  usually  assumed  to  be  uniform,  and  the  local  horizontal  frame 
becomes  parallel  to  the  ground  frame,  which  is  now  inertial.  Assuming  the  combustor 
can  roll  with  respect  to  the  main  body,  most  of  these  changes  can  be  applied  to  the  initial 
set  of  equations  by  zeroing  out  the  appropriate  terms. 


niyl  —fricPB  ~^Pc 

Vfl/cla 

Fi  +  F<?+mvG^ 

{Jb 

*  =  4 

rriQ^c  -nicMM  (Ac“^3c^) 

k  4 

Me  '*'Pc{Fc 

0 

'  0 

me +  ^B^bPb  )  f^V^B^BjC 

» ««• , 

mePB{^c^cfic  "^^b^bPb  "^^big^bic) 

mc0c{^c^cPc  +  ^b^bPb  ^bic^bic) 

The  exception  is  the  set  of  equations  describing  the  missile  CG  position.  In  this  case  it 
is  necessary  to  shift  from  motion  on  the  surface  of  a  sphere  to  motion  over  a  flat  surface. 
The  missile  position  rate  in  the  inertial  frame  is  simply  the  velocity  in  the  body  fhime, 
transformed,  or 


X 

u 

y 

’  -]Jb2h\ 

V 

z 

B 

w 

\  y 

where  h^-wg 


(26) 
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The  surface  distance  traveled  is  simply 


(27) 


Equations  9  and  14  are  unaffected. 

In  this  section,  the  combustor  can  roll  with  respect  to  the  body.  For  the  LDR, 
however,  this  roll  freedom  is  gone,  so  equations  9, 15, 16, 19, 24  (with  G}g=0)  and  26, 

along  with  assumption  21,  were  implemented  in  the  simulation. 


SPECIAL  CASE;  FLAT  EARTH  AND  PITCH  PLANE 


The  assumption  that  motion  is  restricted  to  the  pitch  plane  results  in  an  enormous 
simplification:  the  three  vector  equations  in  Equation  8  are  reduced  to  three  scalar 
equations,  which  can  be  solved  separately.  The  notation  for  the  scalar  forces  and 
moments  is  illustrated  in  Figure  3. 

An  additional  assumption  here  is  that  both  sections  are  symmetric  homogeneous 
cylinders,  so  the  inertia  tensors  of  the  body  and  combustor  are  diagonal  with  the  y  and  z 
elements  equal,  i.e.. 


Ux 

0 

o' 

fcx 

0 

O' 

II 

0 

h 

0 

,  and  fc  = 

0 

0 

0 

0 

0 

0 
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Nb 


FIGURE  3.  Planar  Vehicle  Over  Flat  Earth. 


Since  this  is  the  planar  case,  neither  the  body  nor  the  combustor  roll. 

myii  +  mcCxc  sin5  =  Ab+  {Aq  +  T)cos5—Nc  sin5 

-niygo  sin0  -  -Xb)+ t^xc  cos^j  -  myBw 

myw  +  mcO[l-Xg)  +  mc^XcCosS  =  —NB  —  NcCos5-{Ac  +T)sm5 
+mygQ  cosd + me  C^Xq  sin  6  +  rriydu 

/fl  ^ + me  (/ -  xb  jfiv + ^(/ -  Xfl ) + cos  5]  =  +  3/* 

+(/  -  XB)|-iVe  cosS  -  (i4e  +  r)sin  5 + mt^o  cos© + mc{C^xc  sin  5  -  ©u)j 
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C  +  /nc-^c[^cos5  +  Msin5  +  d{l  - x^)cosS  +  C -^Cc]  =  ~ 

+%|-iVc  +  cosC  -  mc[^(/  -  X5)sin  5  +  6{ucosd~  wsin^)]! 

Equation  9  becomes  6  =  q^.  The  differential  equations  for  position  reduce  to 

Xg  =  UjCOsO  +  wgsinff 
zg  =  -Ug  sin  0  +  Wfl  cosfl 


CONCLUSIONS 


Equations  of  motion  fw  a  missile  consisting  of  two  rigid  bodies  connected  by  a  hinge 
have  been  developed  for  flight  over  a  spherical  rotating  Earth.  These  equations  have  been 
specialized  to  three  simpler  cases:  flight  over  a  spherical  rotating  Earth  where  the  second 
body  is  much  smaller  than  the  first,  flight  over  a  stationary  flat  Earth,  and  pitch  plane 
flight  over  a  flat  Earth. 

For  modeling  the  dynamics  of  more  complex  vehicles,  i.e.,  with  more  sections  or 
with  more  complex  connections,  the  development  by  Abzug  in  Reference  3  would  be 
useful.  The  notation,  while  intricate,  is  well  laid  out  for  handling  the  complexity  of  that 
type  of  vehicle.  For  the  LDR  vehicle,  we  used  both  approaches  for  developing  the  first 
set  of  equations  in  this  report,  and  concluded  that  the  more  intuitive  approach  presented 
here  was  workable  for  two  bodies  and  would  be  clearer  to  present  in  this  report.  As  the 
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number  of  bodies  increases  and  the  connections  become  more  complex,  the  more  intuitive 
approach  taken  here  becomes  impractical. 


NOMENCLATURE 


GENERAL  NOTATION 

Because  this  is  a  two-body  vehicle,  reference  is  made  to  the  two  portions,  the  front 
body  and  the  aft  combustor.  These  two  parts  make  up  the  vehicle. 

[  ]  -  matrix 

(")  -  (tilde  overbar)  -  matrix 
(~)  -  (overbar)  -  vector 


Transformations  and  Coordinate  systems 

Several  coordinate  systems  arc  used  in  this  development.  First,  of  course,  is  the 
inertial  frame,  which  is  assumed  to  be  fixed  in  inertial  space.  Next,  the  ground  frame  is 
attached  to  a  fixed  point  on  the  surface  of  the  Earth.  For  the  flat  Earth,  the  ground  and 
inertial  frames  are  identical.  The  body  frame  travels  and  rotates  with  the  main  body.  The 
combustor  frame  travels  and  rotates  with  the  combustor.  The  local  horizontal  frame 
travels  with  the  body,  but  remains  aligned  with  the  local  horizon.  For  flat  Earth,  the  local 
horizontal  and  ground  frames  remain  aligned. 
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The  coordinate  frames  are  related  to  each  other  by  a  sequence  of  Euler  rotations.  In 
this  discussion,  all  Euler  rotations  are  in  the  sequence  x,y,z.  To  illustrate  with  the 
rotation  from  local  horizontal  to  body  frames: 


whwe 


"1 

0 

0  ■ 

COS0 

0 

-sin0' 

cosyf 

sinyr 

O' 

\Th2b\  = 

0 

COS0 

sin0 

0 

1 

0 

-sinyf 

cosyr 

0 

_0 

-sin0 

COS0 

sin0 

0 

COS0 

0 

0 

1 

^H1b\  = 


cos6cosy 

sin  0  sin  0  cos  -  cos  0  sin 
cos0sin0cosvr  +  sin^sinv' 


cosdsin^  -sin© 

sin0sindsinv^  +  cos0cosv^  sin0cosd 
cos0sin0sinvr-sin0cos0^  cos0cosO 


Other  transformations 

[Tb2c]  -  J^z]  •  body  to  combustor 

\^gih]  =  [”^]yl^]x  ■  ground  to  local  horizontal 
[^//2fl]  =  -  local  horizontal  to  body 
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Derivatives 

A  final  relevant  subject  is  that  of  noninertial  derivatives.  Since  there  are  several 
noninerdal  frames  in  this  development,  the  notation  becomes  a  little  more  intricate  than 
usual. 

—  -  inertial  time  derivative  of  vector  a 

dt 

IQ  -  angular  velocity  of  body  frame  "B"  with  respect  to  the  ground  frame  "G" 

-  time  derivative  of  vector  d  with  respect  to  (usually)  noninertial  frame  "G" 

Note  that  ~  Since  the  angular  velocity 

of  "G"  is  with  respect  to  inertial  space,  the  ”1"  in  the  subscript  usually  is 
dropped,  i.e.,  ©c// =  5>g* 

d^  -  vector  a  expressed  in  components  along  the  body  frame 

Note  that  a  vector  may  be  expressed  in  any  coordinate  system,  regardless  of  its  physical 
meaning.  For  example,  the  angular  velocity  of  the  body  with  respect  to  the  ground 
{Wbig)  ^  expressed  in  components  in  the  body  frame  (agic),  in  components 
along  the  ground  frame  ias/c),  or  any  other  frame,  such  as  the  combustor  frame 
(ms/c).  References  1  and  6  both  contain  good  discussions  of  transfOTmations. 


SYMBOLS 

Superscripts  and  subscripts 
B  -  body 

C  -  combustor  (motor) 
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G  -  ground 
h  -  hinge 
H  -  local  horizontal 
I  -  inertial 

V  -  vehicle  (body  +  combustor) 


Scalar  variables 

Re  -radius  of  Earth 
R  -  distance  travelled  by  main  body 
h  -  altitude 

X  -  position  from  a  reference  point  along  constant  meridian  of  the  spherical  Earth 
T  -  position  from  a  reference  along  constant  parallel  of  the  spherical  Earth 
\  -  latitude  position 

^  -  longitude  position 

m  -  mass 

gQ  -  magnitude  of  gravitational  acceleration  at  sea  level 
M,v,w  -  components  of  velocity  in  body  frame 
p,q,r  -  components  of  angular  velocity  in  body  frame 
x,y,z  -  position  components 
(Oe  -  magnitude  ofEarth's  angular  velocity 


Vector  Variables 
a  -  a  general  vector 
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b  -  a  general  vector 

F  -  external  forces  except  due  to  gravity  and  due  to  the  other  body  via  the  hinge 
G  -  gravitational  acceleration 

M  -  external  moments  except  due  to  the  other  body  via  the  hinge 
X  -  position 
V  -  velocity 
a  -  acceleration 
5)  -  angular  velocity 

P  -  location  of  component  CXj  within  that  component 
/  -  without  subscript,  identity  matrix 

/  -  with  subscript,  inertia  tensor 


Abbreviations 

CG  -  center  of  gravity 
LDR  -  low  drag  ramjet 
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